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This  paper  describes  the  details  of  a  Quadrotor  Unmanned  Aerial  Vehicle  capable  of 
exploring  cluttered  indoor  areas  without  relying  on  any  external  navigational  aids.  An 
elaborate  Simultaneous  Localization  and  Mapping  (SLAM)  algorithm  is  used  to  fuse  infor¬ 
mation  from  a  laser  range  sensor,  an  inertial  measurement  unit,  and  an  altitude  sonar  to 
provide  relative  position,  velocity,  and  attitude  information.  A  wall-following  guidance  rule 
is  implemented  to  ensure  that  the  vehicle  explores  maximum  indoor  area  in  a  reasonable 
amount  of  time.  A  model  reference  adaptive  control  architecture  is  used  to  ensure  stability 
and  mitigation  of  uncertainties.  The  vehicle  is  intended  to  be  Georgia  Tech  Aerial  Robotic 
Team’s  entry  for  the  2010  International  Aerial  Robotics  Competition. 


I.  Introduction 

The  Army,  Navy,  and  the  Air  Force  have  identified  indoor  reconnaissance  and  surveillance  capability  as  a 
top  research  priority  due  to  the  changing  nature  of  the  battlefield.  Miniature  air  vehicles  are  ideal  candidates 
for  such  missions  as  they  can  use  three  dimensional  maneuvers  to  overcome  obstacles  that  cannot  be  overcome 
by  ground  vehicles.  However,  significant  technological  challenges  exist  in  order  to  ensure  reliable  operation  in 
such  environments.  Most  current  algorithms  for  Unmanned  Aerial  System  (UAS)  Guidance  Navigation  and 
Control  rely  heavily  on  GPS  signals, 1-3  and  hence  are  not  suitable  for  indoor  navigation  where  GPS  signal 
is  normally  not  available.  Furthermore,  the  indoor  UAS  must  be  sufficiently  small  in  order  to  successfully 
navigate  cluttered  indoor  environments,  consequently  limiting  the  amount  of  computational  and  sensory 
power  that  can  be  carried  onboard  the  UAS.  Finally,  the  UAS  should  be  designed  to  be  expendable  due  to 
the  dangerous  environments  it  needs  to  operate  in,  hence  low-cost,  low-weight  designs  need  to  be  explored. 
These  restrictions  pose  significant  technological  challenges  for  the  design  of  reliable  Miniature  Air  Vehicle 
(MAV)  platforms  capable  of  navigating  cluttered  areas  in  a  GPS  denied  environment. 

A.  Problem  Statement 

The  sixth  mission  of  the  International  Aerial  Robotics  competition  requires  that  a  MAV  weighing  less  than 
1.5kg  have  the  ability  to  enter  and  navigate  within  an  unknown  confined  environment  in  search  of  a  specific 
marked  target  without  being  detected.  The  mission  also  requires  that  the  MAV  locate  and  bring  back  a 
flash  drive. 
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B.  Conceptual  Solution 


The  Georgia  Tech  Aerial  Robotics  Team  (GTAR)  has  developed  an  indoor  MAV  Unmanned  Aerial  System 
(UAS)  capable  of  exploring  cluttered  indoor  areas  without  relying  on  external  navigational  aids  such  as  GPS. 
The  MAV  uses  an  off-the-shelf  Quadrotor  platform  and  is  equipped  with  off-the-shelf  avionics  and  sensor 
packages.  We  use  an  elaborate  navigation  algorithm  that  fuses  information  from  a  laser  range  sensor,  inertial 
measurement  unit,  and  sonar  altitude  sensor  to  form  accurate  estimate  of  the  vehicle  attitude,  velocity,  and 
position  relative  to  indoor  structures.  We  leverage  the  fact  that  all  indoor  structures  have  walls  to  design  a 
guidance  algorithm  that  detects  and  follows  walls  to  ensure  that  the  navigation  solution  maintains  its  fidelity 
and  maximum  indoor  area  is  explored  in  a  reasonable  amount  of  time.  We  use  a  control  architecture  that 
augments  a  proven  baseline  proportional-derivative  controller  with  an  optional  adaptive  element  that  aids 
in  mitigating  modeling  error  and  other  system  uncertainties. 

C.  Yearly  Milestones 

For  the  first  competition  of  the  6th  IARC  mission,  the  GTAR  Team  aims  to  develop  a  stable  MAV  capable 
of  carrying  an  avionics  payload  for  completing  the  6th  mission.  In  2010,  the  vehicle  will  have  the  ability 
to  navigate  and  explore  the  indoor  environment,  and  detect  the  flash  drive.  Subsequent  yearly  milestones 
include  exploring  the  indoor  environment  without  being  detected  and  a  method  for  picking-up  and  bringing 
back  the  USB  disk  within  allocated  time. 


Figure  1.  GTAR  System  Architecture 


II.  Description  of  Vehicle 


A.  Aerial  Platform 

Quadrotors  have  become  a  very  popular  choice  for  MAV  due  to  their  relatively  high  payload  capacity  and 
high  maneuverability.4  Furthermore,  unlike  helicopters,  Quadrotors  avoid  the  use  of  mechanical  parts  for 
exerting  moments  and  forces  required  for  maneuvering.  The  2009  GTAR  team  used  a  coaxial  helicopter 
for  2009  IARC  competition,5  however,  no  off-the-shelf  coaxial  rotorcraft  platforms  are  available  to  meet  the 
2010  payload  requirements.  Hence,  in  2010,  we  will  use  a  Quadrotor  platform. 

We  selected  the  AscTec  Pelican  Quadrotor  made  by  Ascending  Technologies  GmbH  as  the  base  airframe 
(see  Fig. 2(a)).  The  vehicle  structure,  motors,  and  rotors  of  AscTec  Pelican  were  used  without  modification. 
The  vehicle  generates  lift  using  four  fixed  pitch  propellers  driven  by  electric  motors.  Control  is  achieved 
by  creating  a  relative  thrust  offset  between  the  propellers.  Quadrotors  can  either  be  flown  with  diamond 
configuration  (front,  right,  back,  left  motors  are  used  to  effect  pitching,  rolling,  and  yawing  motion)  or  square 
configuration  (front-right,  back-right, back-left,  front-left  motors  are  used  to  effect  pitching,  rolling,  and  yaw- 
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ing  motion).  Although  many  Quadrotors  in  aerial  robotics  community  fly  with  diamond  configuration,4, 6,7 
we  selected  the  square  configuration  (shown  in  Fig  2(b))  to  allow  for  more  flexibility  in  sensor  mounting 
locations. 


(a)  AscTec  Pelican  Platform 


Figure  2.  The  2010  GTAR  Team  chose  to  use  the  Ascending  Technologies  Pelican  as  aerial  platform. 


B.  Guidance  Navigation  and  Control  System 

1.  Guidance  System 

The  developed  guidance  system  uses  only  locally  available  information  gathered  through  the  onboard  sensors, 
which  include  a  laser  range  scanner.  A  simple  velocity  field  method  was  employed,  with  a  few  basic  rules 
for  identifying  different  topology  of  interest.  In  essence,  the  shape  of  the  environment  determines  where  the 
vehicle  decides  to  go.  Each  point  in  a  laser  scan  contributes  a  small  incremental  velocity,  and  the  average 
velocity  over  all  the  scan  points  is  used  as  a  commanded  velocity  to  the  velocity  control  loop.  Equation  1 
gives  the  equation  used  to  calculate  the  incremental  velocity  at  each  scan  angle.8 

f  7 i  =0i  +  f(^tf)-7r  (0  <  n  <  2rgoal)  ^ 

[  7 i  =  g0al  <  Vi) 


The  incremental  velocity  at  each  measurement  angle,  7*,  is  determined  by  the  range  measurement, 
the  range  angle,  Oi  and  the  user-defined  desired  distance  from  the  wall,  rgoai.  The  commanded  velocity  in 
the  body  frame  is  calculated  according  to  Eq.  (2),  where  Kv  is  the  velocity  gain  and  n  is  the  number  of  scan 
points  with  valid  range  readings.  A  user-defined  minimum  safe  distance  rmin  (by  default  set  to  the  vehicle 
maximum  radius)  is  used  to  adaptively  increase  the  gain  Kv  as  a  means  of  providing  obstacle  avoidance 
behavior  as  an  inherent  part  of  the  velocity  guidance  algorithm.  The  body  frame  velocity  commands  are 
transformed  to  the  local  inertial  frame  using  the  vehicle  estimated  heading,  ip,  as  shown  in  Eq.  (3). 
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Heading  control  is  achieved  by  using  the  angle  parameters  of  the  line  segments  extracted  from  the  scan 
data  using  the  Polar  Recursive  Least  Squares  (PRLS)  algorithm.  The  vehicle  is  given  a  commanded  heading 
to  align  itself  with  a  portion  of  the  wall.  The  default  behavior  is  to  use  the  farthest  contiguous  wall  segment, 
starting  from  the  beginning  of  the  scan  on  the  right  and  continuing  counterclockwise  until  a  gap  is  found 
in  the  wall  that  is  large  enough  for  the  vehicle  to  fly  through.  Using  this  setting  causes  the  vehicle  to  turn 
around  when  it  encounters  a  “dead  end”  hallway  while  still  making  proper  outside  turns  to  go  through 
doors  or  into  side  hallways.  The  average  of  the  incremental  velocity  commands  provide  the  vehicle  with 
a  flight  direction  and  speed  that  varies  appropriately  depending  on  the  local  environment  topology.  This 
guidance  algorithm  produces  basic  wall- following  behavior,  whereby  the  vehicle  will  continue  along  a  wall 
until  it  encounters  an  opening,  an  inside  corner,  or  an  outside  corner.  As  the  vehicle  is  flying  along  a  wall, 
small  changes  in  the  velocity  command  keep  the  vehicle  at  the  desired  distance  from  the  wall  as  shown  in 
Fig.  3.  The  algorithm  also  mitigates  inside  and  outside  corners  (see  reference  9  for  terminology  description) 
as  shown  in  figure  4.  The  default  behaviour  of  detecting  and  mitigating  gaps  in  the  environment  is  shown 
in  5.  Further  information  can  be  found  in  reference  8  and  10. 


Vehicle  Y  Axis  (m) 


Vehicle  Y  Axis  (m) 


(a)  Too  close 


(b)  Correct  distance 


(c)  Too  far 


Figure  3.  The  guidance  algorithm  generates  a  velocity  vector  from  the  average  of  vectors  generated  for  each 
range  measurement.  Along  a  section  of  straight  wall,  the  algorithm  gives  corrections  to  keep  the  vehicle  a 
desired  distance  from  the  wall,  which  is  indicated  by  a  dotted  line.  The  wall  is  shown  by  a  solid  vertical  line, 
with  individual  range  measurements  shown  by  circles.  Individual  velocity  increments  are  indicated  by  a  line 
showing  the  magnitude  and  direction  at  each  measurement  point.  The  total  commanded  velocity  is  shown  by 
a  line  emanating  from  the  vehicle,  which  is  represented  by  a  triangle. 


(b)  Outside  corner 


Figure  4.  Inside  and  outside  corners  are  handled  with  no  special  topology  check  required.  The  average  velocity 
vectors  generate  a  total  commanded  velocity  that  takes  the  vehicle  smoothly  through  the  maneuver.  Heading 
commands  are  generated  to  turn  the  vehicle  parallel  with  the  next  wall  face  as  soon  as  it  is  detected. 


4  of  12 


American  Institute  of  Aeronautics  and  Astronautics 


(a)  Small  gap  (b)  Large  Gap 


Figure  5.  Any  gap  in  the  wall  is  detected  by  the  PRLS  wall  estimation  algorithm.  Gaps  that  are  smaller  than 
the  desired  threshold  are  flown  by  with  no  effect  on  the  commanded  velocity.  Gaps  that  are  large  enough  for 
the  vehicle  to  fly  through,  such  as  a  hallway  or  door,  cause  the  commanded  velocity  vector  to  bend  toward  the 
opening.  If  the  vehicle  enters  a  hallway  or  goes  through  a  door  where  the  minimum  lateral  separation  is  not 
at  least  twice  the  wall  follow  distance,  the  vehicle  simply  keeps  an  equal  distance  from  both  sides.  Otherwise, 
the  vehicle  picks  up  the  wall  on  the  right  hand  side  and  keeps  the  desired  distance  from  it  as  flight  continues. 


2.  Stability  Augmentation  System  (SAS) 

The  Quadrotor  platform  is  inherently  unstable,  that  is,  without  control  inputs,  the  platform  would  enter  an 
uncontrolled  drift  in  velocity  and  angular  rates  and  collide  with  the  ground  or  nearby  obstacles.  Quadrotors 
are  also  known  to  be  notoriously  hard  to  control  even  for  human  pilots,  particularly  because  the  relationship 
between  thrust  and  stick  deflection  is  nonlinear  and  because  attitude  is  coupled  heavily  with  velocity.  Hence, 
it  is  desirable  to  integrate  angular  rate  damping  to  aid  the  pilot  in  controlling  the  Quadrotor.  Let  p,  q,  and 
f  denote  the  gyroscope  measurements  of  the  Quadrotor  roll,  pitch,  and  yaw  rates,  and  d(/>p,  6gp,  and  Si/, 
denote  the  pilot  roll,  pitch,  and  yaw  stick  deflections,  then  the  actual  stick  deflection  commands  are  assigned 
using  the  following  proportional  control  logic: 


$4>  —  $(pp  Kpf), 

(4) 

$6  $ Op  KqQ) 

(5) 

fi'ip  =  fii/jp  Krr . 

(6) 

In  equation  4,  Kp,  Kq,  and  Kr  denote  the  linear  gains  chosen  to  provide  appropriate  rate  damping. 

3.  Control  Algorithm 

The  complexity  of  the  control  system  depends  not  only  on  the  quantities  being  controlled,  but  also  on  the 
dynamics  of  the  system  itself.  Unlike  ground  vehicles,  unstable  air  vehicles  are  susceptible  to  oscillation 
and  divergent  flight  when  the  control  system  is  not  properly  tuned.  Even  for  stable  flying  vehicles,  cou¬ 
pling  between  lateral  and  longitudinal  motion  as  well  as  aerodynamic  interaction  with  the  environment  must 
be  considered.  The  control  architecture  used  by  the  GTAR  2010  team  leverages  the  proven  Model  Refer¬ 
ence  Adaptive  Control  architecture  developed  for  control  of  VTOL  UAS  throughout  their  flight  envelop  by 
Georgia  Tech  UAV  Research  Facility.11-13  In  this  architecture,  a  position  control  loop  generates  a  velocity 
command,  a  velocity  control  loop  generates  an  attitude  command,  and  an  attitude  control  loop  generates 
servo  commands  to  stabilize  the  vehicle  by  controlling  the  angular  rate.  Kannan  has  shown  that  such  nested 
and  cascaded  control  loop  architecture  with  actuator  saturation  can  indeed  be  used  to  control  VTOL  UAS.12 

This  system  of  nested  control  loops  requires  that  the  vehicle  maintain  an  estimate  of  its  position,  velocity, 
attitude,  and  angular  rate.  In  the  following,  we  present  a  brief  description  of  the  implemented  control 
architecture,  the  reader  is  referred  to  references  11,12,14,15  for  further  details. 

Let  x(t)  £  9?"  denote  the  state  vector,  let  <5  £  denote  the  control  input,  then  the  dynamics  of  the 
Quadrotor  can  be  generically  represented  as: 


&  =  f(x(t),6(t)). 


(7) 


It  is  assumed  that  the  exact  model,  Eq.(7)  is  not  available,  may  have  changed,  or  is  not  sufficiently 
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accurate  and  introduce  an  approximate  inversion  model  /( x,  Scmd )  which  can  be  inverted  to  determine  the 
control  input:  6  =  /-1(a;,  v).  Here  v  is  the  pseudo  control  input,  which  represents  the  desired  model 
output  x  and  is  expected  to  be  approximately  achieved  by  S.  This  approximation  results  in  a  model  error 
A(z)  =  f(x)  -  /(a;).11’14’15 

A  second  order  reference  model  is  selected  to  characterizes  the  desired  response  of  the  system: 

Xrm  =  frm(Xrrm‘r(t')'),  (8) 

Where  frm(xrm(t),r(t ))  denote  the  reference  model  dynamics  and  r(t)  denotes  a  bounded  and  piecewise 
continuous  external  command.  A  tracking  control  law  consisting  of  a  linear  feedback  part  vpd  =  Kx ,  a  linear 
feed- forward  part  vcrm  =  xrm,  and  an  adaptive  part  va d{x)  is  proposed  to  have  the  following  form: 

^  =  ^ crm  T  Vpd  Vad-  (9) 

Defining  the  tracking  error  erm  as  erm(t)  =  xrm{t)  —x(t),  then,  letting  A  =  —K  the  tracking  error  dynamics 
are  found  to  be:14 

&rm  =  Ae.rm  “t“  \Vad{x)  A(x)].  (19) 

The  baseline  full  state  feedback  controller  vpd  =  Kx  is  assumed  to  be  designed  such  that  A  is  a  Hurwitz 
matrix,  hence  for  any  positive  definite  matrix  Q  G  dtnxn  ,  a  positive  definite  solution  P  £  ffinxn  exists  to  the 
Lyapunov  equation.  This  architecture  allows  for  an  optional  adaptive  element  (whose  output  is  denoted  by 
vad)  to  be  incorporated  for  mitigating  model  errors  and  reducing  steady-state  tracking  error.  The  adaptive 
part  of  the  control  law  is  represented  using  a  Single  Hidden  Layer  Neural  Network  (NN)  or  a  Radial  Basis 
Function  NN: 

Vad(x)  =  WTa(  x),  (11) 

where  W  denote  the  NN  weights  and  a(x)  denotes  an  appropriate  radial  basis  function.  Using  theory  and 
extensive  flight  testing,  it  has  been  demonstrated  that  the  stability  of  the  presented  MRAC  architecture  for 
trajectory  tracking  control  of  VTOL  UAS11,12  with  adaptive  laws  similar  to: 

W  =  -§{x)eTPBYw  +  K\\e\\W  (12) 

where  is  a  positive  definite  learning  rate  matrix,  and  n  denotes  the  gain  for  an  e-modification  term.16 
In  the  presented  control  architecture,  the  output  of  the  adaptive  element  can  be  replaced  by  an  integrator  if 
desired.  This  reduces  the  control  logic  to  Proportional-Derivative-Integral  type. 

Figure  6  depicts  the  structure  of  the  NN  based  adaptive  controller  with  Pseudo  Control  Hedging  (PCH). 
PCH  is  an  innovative  method  that  has  been  developed  for  ensuring  that  the  adaptive  element  is  not  affected 
by  undesirable  actuator  effects  such  as  saturation.14, 17  PCH  uses  the  measurement  of  the  actuator  commands 
to  scale  the  reference  model  output  such  that  the  adaptive  controller  does  not  saturate. 

4-  Navigation  Algorithm 

A  variety  of  SLAM  algorithm  implementations  are  available  for  free  use  at  the  web  site  OpenSLAM.org.  The 
algorithm  used  for  the  preliminary  research,  called  CoreSLAM,18  was  chosen  primarily  because  it  is  simple, 
easy  to  implement,  and  it  uses  integer  math  where  possible  to  improve  computational  speed.19  There  are 
two  main  parts  to  any  SLAM  routine.  The  first  task  is  to  measure  distance  to  obstacles  or  landmarks  in  the 
environment,  and  to  map  them  given  the  vehicle’s  position  and  orientation  (i.e.  mapping).  The  second  task 
is  to  determine  the  best  estimate  of  the  vehicle’s  position  and  orientation  based  on  the  latest  scan  (or  series  of 
scans)  given  a  stored  map  (i.e.  localization).  The  mapping  and  localization  tasks  are  performed  together  to 
maintain  the  most  current  map  and  position  estimate.  The  GTAR  team  has  developed  an  Iterative  Closest 
Point  (ICP)  scan-matching  algorithm  in-house.  The  algorithm  were  developed  to  prioritize  localization  with 
respect  to  the  immediate  environment,  and  place  lesser  emphasis  on  building  and  maintaining  highly  accurate 
global  maps.  Hence  the  “map”  in  the  ICP  algorithm  consists  entirely  of  a  singe  previous  scan.  However, 
with  the  ICP  algorithm  individual  scans  can  be  saved  and  post-processed  into  a  global  map  if  desired. 

Figure  7(a)  shows  a  simulated  building  interior  being  explored  by  the  Quadrotor  with  a  scanning  laser 
rangefinder.  Figure  7(b)  shows  the  map  generated  during  a  simulated  flight. 

The  inherent  nonlinearities  in  the  vehicle  dynamics  and  the  measurement  sensors  are  handled  through  the 
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Figure  6.  The  structure  of  the  NN  based  adaptive  controller  with  Pseudo  Control  Hedging  used  for  flight 
control.  This  adaptive  controller  can  effectively  mitigate  uncertainty  in  the  UAS  dynamics  without  being 
affected  by  actuator  saturation 


(a)  Mapping  a  simulated  environment 


(b)  Map  generated  during  simulation 


Figure  7.  The  map  maintained  by  the  CoreSLAM  routine  represents  an  occupancy  grid,  where  the  value  of 
each  pixel  in  the  image  represents  the  likelihood  that  a  particular  grid  square  is  occupied.  Here,  lighter  colors 
represent  free  space,  while  darker  colors  represent  obstacles  and  medium  gray  areas  are  unexplored.  Areas 
with  higher  contrast  represent  greater  certainty  due  to  longer  observation  periods  during  the  flight.  The  green 
triangle  represents  the  vehicle’s  estimated  position  and  heading. 
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use  of  an  Extended  Kalman  Filter  (EKF).  An  existing  EKF-based  navigation  filter  architecture  developed  at 
the  Georgia  Tech  UAV  Research  Facility  is  utilized  as  part  of  the  indoor  navigation  system.2  The  navigation 
algorithm  developed  by  the  GTAR  team  augments  the  existing  EKF  based  architecture  to  function  without 
GPS  signals  by  using  the  range  information  obtained  from  the  laser  range  scanner  and  the  sonar  altimeter.10 

C.  Flight  Termination  System 

A  manual  takeover  switch  is  provided  so  that  a  human  safety  pilot  can  take  over  control  when  required.  The 
system  is  also  provided  with  a  remotely  controlled  “kill-switch”  that  ensures  power  to  the  motors  is  killed 
when  triggered. 


III.  Payload 


A.  Sensor  Suite 

The  GTAR  entry  uses  three  primary  measurement  sensors  for  navigation,  stability  and  control.  These 
devices  are  a  laser  range  finder  and  a  sonar  altimeter  for  the  GNC  software,  and  an  inertial  measurement 
unit  (IMU)  for  stability  augmentation.  The  IMU  employed  by  the  GTAR  team  is  the  ADIS-16365-BMLZ 
built  by  Analog  Devices  Inc.  It  consists  of  a  tri-axis  digital  gyroscope  and  tri-axis  accelerometere  that  can 
measure  forces  up  to  ±18  g.  The  laser  range  finder  used  is  the  Hokuyo  URG-04LX-UG01.  It  is  capable  of 
measuring  distances  up  to  4  m  and  has  a  maximum  detection  area  of  240  degrees,  with  a  resolution  of  1  mm 
and  0.36  degrees  respectively.  The  sonar  altimeter  used  is  the  MB1040  LV  MaxSonar  EZ4  high  performance 
ultrasonic  range  finder.  It  is  capable  of  measuring  distances  up  to  6.45  m  away  with  resolution  of  25.4  mm. 
These  sensors  are  integrated  around  the  Gumstix  Overo  Fire  onboard  computer  which  is  a  small  and  cost 
effective  ARM  Cortex-A8  OMAP3530  based  computer-on-module.  It  is  equipped  with  256  MB  Flash  RAM, 
I2C  and  is  UART  and  SPI  capable.  The  onboard  software  leverages  our  previous  work  in  rotorcraft  control 
and  allows  us  to  fully  utilize  the  GUST  software  suite  of  the  GeorgiaTech  UAV  Research  Facility.20 

B.  Communications 

The  Gumstix  overo  computer  can  communicate  via  802. llg  and  Bluetooth  wireless  links.  The  computer  will 
communicate  with  a  ground  computer  using  a  wireless  Local  Area  Network  (LAN)  link. 

C.  Power  Management  system 

The  system  uses  off-the-shelf  battery  packs  which  have  a  track  record  of  proven  safety.  Two  three  cell 
Lithium  Polymer  Ion  batteries  are  used,  one  drives  the  motors  to  provide  lifting  power,  and  the  other  runs 
the  onboard  computer.  The  batteries  are  charged  off-board  using  off-the-shelf  battery  chargers.  The  vehicle 
comes  with  an  integrated  audible  low-power  warning,  battery  voltage  can  also  be  measured  and  transmitted 
to  the  ground  station. 


IV.  Operations 


A.  Flight  Preparations 

Before  each  autonomous  flight  test  or  competition  trial,  a  checklist  of  preparations  are  to  be  followed  (see 
table  A). 

B.  Man/Machine  Interface 

A  ground  station  based  on  the  GIT  GUST  software  environment  will  continuously  monitor  the  flight  vehicle 
and  display  health  and  status  information  during  the  flight.20  The  flight  vehicle  will  send  its  current  estimated 
position/heading,  obstacle  locations,  and  battery  voltage  via  a  wireless  LAN  data  link.  In  addition,  a  frame- 
grabber  is  used  to  retrieve  images  from  the  incoming  video  stream  for  processing.  Instructions  from  the 
ground  station,  including  the  adjustment  of  system  parameters  during  manual  flight,  are  transmitted  over  a 
wireless  LAN  data  link.  A  safety  pilot  link  is  included,  which  operates  via  a  separate  2.4GHz  radio  uplink. 
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Table  1.  Flight  Checklist 


Steps  completed  days  before  flight  session 

Charge  flight  batteries,  transmitter  batteries 

Load  new  software  onboard  and  ground  station 

Complete  hardware-in-the-loop  (HITL)  tests  to  ensure 
proper  operation  of  any  code  changes 

Steps  completed  day  of  flight  session 

Ensure  all  flight  test  equipment  is  present. 

Set  up  ground  station. 

Steps  completed  before  each  flight 

Clearly  brief  safety  pilot  of  intention  of  flight 

Check  structural  integrity  of  vehicle  and  ensure  proper 
center-of-gravity  position. 

During  flight  test 

Pilot  has  primary  discretion  on  whether  to  take  manual  con¬ 
trol  if  vehicle  is  in  jeopardy.  Besides  this  discretion,  safety 
pilot  will  only  obey  judges  or  ground  station  operator. 

Once  the  low  voltage  warning  tone  is  heard,  safety  pilot 
takes  control  and  lands  the  aircraft. 

V.  Risk  Reduction 


A.  Vehicle  Status  Monitoring 

The  flight  vehicle  continually  monitors  its  surroundings  for  potential  hazards  and  obstacles  using  the  onboard 
laser  range  scanner.  The  information  about  potential  hazard  can  be  transmitted  to  the  ground  station  for 
monitoring. 

1.  Shock  and  vibration  isolation 

The  chosen  onboard  electronics  have  inherent  tolerance  to  shock  and  vibration.  Further  vibration  reduction 
is  achieved  through  careful  mounting  of  the  hardware.  The  avionics  package  is  mounted  close  to  the  center 
of  gravity  to  minimize  motion  induced  due  to  body  rotations.  The  IMU  is  mounted  directly  on  the  avionics 
board.  The  laser  range  scanner  and  the  sonar  altimeter  are  mounted  using  a  low  cost  vibration  isolation 
mechanism. 

2.  Electromagnetic  Interference  (EMI) /Radio  Frequency  Interference  (RFI)  Solutions 

The  chosen  quadrotor  platform  has  brushless  motors,  which  has  reduced  EMI  signature.  Further  EMI 
mitigation  is  achieved  by  mounting  the  avionics  package  at  the  center  of  the  airframe,  and  thus  spatially 
separating  it  from  the  motors.  Proper  electric  grounding  and  additional  capacitors  are  used  to  provide 
further  protection  against  EMI.  A  2.4GHz  transmitter  was  chosen  for  the  video  link,  the  safety  pilot  radio 
control  link,  and  the  data  link.  This  eliminates  the  typical  “servo  jitter”  affecting  UAVs  operating  with 
900MHz  transmitters  nearby.  Possible  interference  between  the  different  2.4GHz  systems  is  reduced  by 
proper  shielding  and  location  of  antennas. 

B.  Safety  to  Bystanders 

The  Quadrotor  platform  used  in  this  work  has  a  protective  shroud  that  minimizes  the  risk  of  rotor  strike 
and  improves  crash- worthiness.  Further  safety  is  incorporated  by  using  off-the-shelf  battery  packs  with  a 
track  record  of  proven  safety.  A  manual  takeover  switch  is  provided  so  that  a  human  safety  pilot  can  take 
over  control  when  required.  Finally,  the  system  is  also  provided  with  a  remotely  controlled  “kill-switch”  that 
ensures  power  to  the  motors  is  killed  when  triggered. 
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C.  Modeling  and  Simulation 

1.  Modeling 

Quadrotor  dynamics  flying  in  configuration  shown  in  Fig. 2(b)  has  been  modeled  in  simulation.  Assuming 
near  hover  aerodynamics,  fuselage  aerodynamics  and  forward  flight  rotor  aerodynamics  can  be  neglected. 
Hence,  the  total  force  acting  on  the  Quadrotor  is  composed  only  of  thrust  and  gravity  forces.  Newton’s 
second  law  in  the  body  axis  can  be  written  as: 

0  0  -(ti  +  t2  +  t3  +  t4) 

where  r,;  represents  thrust  magnitude  on  the  itli  rotor  for  i  =  1,2,  3, 4.  Fg  represents  gravity  force  acting  on 
the  vehicle  in  the  body  frame,  v  £  ?ft3  is  the  velocity  in  the  body  frame,  is  the  derivative  of  the  body 
velocity  with  respect  to  the  body  frame,  and  u>  £  -R3  is  the  angular  rate  of  the  body. 

Neglecting  forward  flight  aerodynamics,  total  moment  acting  on  the  Quadrotor  composes  of  four  different 
sources:  hub  yawing  moment  (M^y),  differential  thrust  moment  (Mdt),  inertial  reaction  moment  and 

gyroscopic  moment  (Mgi/).4,6’7  The  primary  moment  contributions  are  from  hub  yawing  moment  and 
differential  thrust  moment  while  inertial  reaction  moment  and  gyroscopic  moment  provides  insignificant 
contribution.  Euler’s  law  in  the  body  axis  can  be  written  as 


r-,  av 

r a  =  m— — hwx  mv 
M  at 


(13) 


M  -  Mhy  +  M([f  +  Mir  +  Mgy  —  I  Co  +  U)  x  Ilo 

where  /  is  the  Quadrotor  inertia  matrix.  The  individual  moment  components  are  defined  as  follows: 

Mhy  =  0  0  —  Ml  -f-  M2  —  -V/3  -}-  jV/4 

ly  (-Ti  -  t2  +  t3  +  t4)  lx (n  -  r2  -  73  +  r4) 


n  T 


Mdt  = 
MiT  = 


i  T 


0 


0  0  —  (/rfli  —  IrCl 2  T  bl'-i  —  1 1  (-.1 ) 


1  T 


Mgy  — 


— q(IrCl  1  —  /rfl 2  T  Ij- -3  —  /rH4)  p(/rH4  —  /rfl 2  T  lr- -.3  —  /rfl4) 


(14) 

(15) 

(16) 

(17) 

(18) 


where  Mi  is  hub  yawing  moment  magnitude  of  the  ith  rotor  acting  on  the  body.  IT;  is  angular  velocity 
magnitude  of  the  ith  rotor.  Ir  is  moment  of  inertia  of  the  rotor  blade.  lx  and  ly  are  distance  from  center  of 
gravity  to  rotor  hub  in  x  and  y  direction,  p  and  q  are  roll  and  pitch  rates  written  in  body  axis.  The  total 
moment  acting  on  the  body  is  formed  by  combining  the  above  terms: 


M 


ly{— Ti  -  t2  +  t3  +  r4)  —  q(IrQi  -  Ir& 2  +  Ir ^3  —  /rH4) 

Ix(ti  -  72  —  r3  +  r4)  +  p(Ir Hi  -  Irfl2  +  I, M3  -  /,  H4) 
—  Ml  +  M2  —  A/3  +  M4  —  (/rfl  1  —  /rfl 2  “t”  I'ril‘3  —  ItMa) 


(19) 


Vehicle’s  pitching  motion  can  be  generated  by  commanding  differential  Revolutions  Per  Minute  (RPM) 
between  two  front  motors  and  two  back  motors.  Rolling  motion  can  be  generated  by  commanding  differential 
RPM  between  two  right  motors  and  two  left  motors.  Yawing  motion  can  be  generated  by  increasing  motor 
RPMs  on  one  diagonal  and  reducing  motor  RPMs  on  the  other  diagonal.6  Typical  helicopter  controls  can 
therefore  be  mapped  to  motor  commands  Xi  using  Eq.(20). 


Xi  =  \J St  —  <5^  +  Sg  +  Sjp  x2  =  \/St  —  5<j>  —  Se  +  5$ 

X3  =  \J  St  +  5<j>  —  dg  —  S^p  x4  =  \J &t  +  5<j>  +  So  +  Sip  (20) 


where  St,  S Sg,  and  5 ^  represent  thrust,  roll,  pitch,  and  yaw  commands.  In  this  form  the  commands  are 
equivalent  to  a  helicopter’s  collective,  lateral  cyclic,  longitudinal  cyclic,  and  tail  rotor  commands.  A  second 
order  model  is  used  to  relate  motor  command  x,;  to  motor  RPM  SI,;.  The  second  order  model  consist  of 
two  cascaded  first  order  systems:  the  first  one  relates  the  motor  commands  to  the  motor  states,  and  the 
second  one  relates  the  motor  states  to  rotor  RPM.  Rotor  aerodynamics  is  modeled  using  blade  element 
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and  momentum  theory.  The  relationship  between  motor  command  Xi  ,  rotor  angular  velocity  Q,,  thrust  r,;, 
and  moment  Mi  is  modeled  similar  to  reference  21.  Vehicle’s  parameters  including  moment  of  inertias  and 
maximum  achievable  RPM  are  currently  being  refined  through  experimentation. 

2.  Simulation 

The  GTAR  team  utilizes  existing  simulation  software  developed  for  research  projects  at  Georgia  Tech  UAV 
lab.22  The  simulation  significantly  reduces  development  time  as  the  team  can  adopt  navigation  filter  and 
controller  already  implemented  in  other  UAVs.  The  simulation  comes  complete  with  modeling  of  uncertain¬ 
ties  such  as  gusts,  and  modeling  of  indoor  environments.  All  sensors  are  elaborately  emulated  and  their  noise 
properties  are  reproduced  for  testing  purposes.  Onboard  code  developed  in  simulation  is  directly  used  for 
autonomous  flight.  The  setup  is  also  capable  of  hardware-in-the-loop  (HITL)  test  (simulating  only  vehicle 
dynamics  and  sensor  readings).  Figure  2  depicts  a  screen-shot  of  the  vehicle  in  simulation. 


Figure  8.  Quadrotor  Performing  Wall  Following  in  Simulation 


VI.  Testing 

The  GTAR  system  is  being  rigorously  subjected  to  flight  testing  at  the  indoor  test  flight  facility  at 
Georgia  Tech.  The  VICON  camera  based  object  tracking  system  is  being  used  to  validate  the  navigation 
algorithm.  We  are  using  the  protocols  developed  by  the  GTAR  team  for  the  2009  effort  for  ensuring  safety, 
efficiency,  and  reliability  in  flight  tests. 


VII.  Conclusion 

We  presented  the  details  of  a  Quadrotor  Unmanned  Aerial  Vehicle  intended  for  exploring  indoor  areas. 
The  vehicle  uses  an  off-the-shelf  platform  equipped  with  off-the-shelf  avionics  and  sensor  packages.  Infor¬ 
mation  from  a  scanning  laser  range  sensor,  inertial  measurement  unit,  and  a  altitude  measurement  sonar 
are  fused  to  form  an  elaborate  navigation  solution  using  Simultaneous  Localization  and  Mapping  (SLAM) 
methods.  An  important  feature  of  this  navigation  architecture  is  that  it  does  not  rely  on  any  external 
navigational  aid,  such  as  Global  Positioning  System  signal.  The  information  from  the  navigation  solution 
is  processed  by  a  guidance  logic  which  detects  and  follows  walls  in  an  indoor  environment  to  ensure  that 
maximum  area  of  the  indoor  environment  is  traversed  in  a  reasonable  amount  of  time. 

A  cascaded  inner-outer  loop  controller  architecture  which  relates  stick  commands  to  attitude  commands 
and  attitude  commands  to  velocity  commands  is  used.  The  control  architecture  employs  an  optional  adaptive 
element  which  can  be  used  to  mitigate  modeling  error  and  other  system  uncertainties.  The  control  system 
also  uses  a  linear  Stability  Augmentation  System  that  uses  rate  feedback  to  dampen  the  vehicle  angular  rate 
response. 

An  elaborate  simulation  model  of  the  vehicle  has  been  developed  and  the  navigation  and  control  algo¬ 
rithms  have  already  been  validated  in  simulation.  Efforts  for  flight  testing  of  the  vehicle  are  currently  in 
progress.  The  Georgia  Tech  Aerial  Robotics  team  intends  to  compete  in  the  2010  IARC  competition  with 
this  vehicle. 
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